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Abstract. In this paper, an optimal trajectory planning problem for a single-link flexible- 
joint manipulator is studied. A global feedback-linearization technique is first applied to 
formulate the nonlinear inequality-constrained optimization problem in a suitable way. 
Then , an exact and explicit structural formula for the optimal solution of the problem is 
derived and the solution is shown to be unique. It turns out that the optimal trajectory 
planning and control can be done off-line, so that the proposed method is applicable to 
both theoretical analysis and real-time tele-robotics control engineering. 


I 


1. Introduction 

An optimal inequality-constrained trajectory plan- 
ning problem for a standard single- link flexible-joint ma- 
nipulator is studied in this paper. 

From a structural point of view, a robot arm is a 
weakly-coupled multi-link mechanical transmission chain. 
Hence, the study of a single-link manipulator (a unit of 
a robot arm or an independent mechanism) is of funda- 
mental importance. 


It is well known that a trajectory planning problem 
for a flexible-joint manipulator has a nonlinear model. 
If we consider such a trajectory planning problem under 
certain additional optimality criterion, then we will en- 
counter a constrained nonlinear optimization problem. 
No analytic closed-form optimal solution can be found 
for such problems in general. However, for a single- 
link flexible-joint manipulator with single control input, 
Marino and Spong (1986) shown that a nonlinear feed- 
back configuration can be designed to linearize the non- 
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linear system globally. The basic idea is, roughly speak- 
ing, that one can find a nonlinear feedback to “cancel” 
the nonlinearity of the system and obtain a linear plant 
and a linear feedback, leaving the nonlinearity to an ex- 
plicit transformation. The advantage of this approach 
is that the final result is exact (no linearization error) 
after a nonlinear inverse transform. This mathematical 
technique is of course well known in nonlinear control 
theory (see, for example, Isidori (1989)). Nevertheless, 
based on this result, we show in this paper that if we con- 
sider a minimum control-energy criterion for the trajec- 
tory planning (with inequality-constraints) of such ma- 
nipulators, then an explicit formulation of the optimal 
solution for the overall nonlinear constrained optimiza- 
tion problem can be obtained in closed form. 

The proposed new approach for obtaining an ex- 
act optimal solution explicitly for such an inequality- 
constrained nonlinear optimization problem is novel in 
mathematics and very useful in robotics engineering since 
it provides us an analytic solution before the control pro- 
cess is started, so that no on-line computer is needed 
in the real-time applications (unless the environment is 
changing and needs to be adapted), which is sometimes 
impossible in certain control processing such as in some 
tele- robotics control in aerospace engineering. Another 
advantage of closed-form solutions over numerical solu- 
tions is the convenience in theoretical analysis of the op- 
timal trajectory planning. Even if in the case that the 
resultant analytic optimal trajectory cannot be traced 
by actual control inputs, we know the exact optimal tra- 
jectory to be approximated. 

This paper is organized as follows: We first describe 
the optimal trajectory planning problem for a single- 
link flexible- joint manipulator. Then, we use a stan- 
dard global feedback- linearization technique to formulate 
the nonlinear inequality-constrained optimization prob- 
lem in a suitable way. Based on this mathematical model, 
we finally give an explicit structural solution for the prob- 
lem in a closed-form. 


2. Description of the Problem 

Consider a single-link flexible-joint manipulator as 
shown in Figure 1. 



Figure 1. A single- link flexible-joint manipulator 

Damping will be ignored in this system for simplicity. 

The joint is assumed to be of revolute type and the link 

is assumed to be rigid with inertia ij about the axis of 

rotation. Let 0\ be the link-angular variable and 0 2 the 

actuator-shaft angle. Suppose that the rotor inertia of 

the actuator is / 2 . Assume also that the flexible joint is 

modeled as a linear spring of stiffness K . Then, by the 

Euler- Lagrange equations we have the following motion 

equations for this manipulator: 

I\ 9\ + MgLsm(9\) + K{6\ — 0 2 ) = 0 
•• . ( 1 ) 
I2&2 — A ($1 ~~ @2) — u > 

where M is the total mass of the link, L the distance 
from the mass-center of the link to the axis of the ro- 
tation, g the acceleration constant of gravity, and u the 
(generalized) force-input applied to the shaft by the ac- 
tuator. 

Since from a mathematical point of view there is no 
difference between bend and swivel joints (see, for exam- 
ple, Section 5.3 in Nagy and Siegler (1987)), the problem 
under investigation has rather wide applications. 

We will consider an optimal point-to-point trajec- 
tory planning problem for this model. To describe the 
problem more precisely, let p — p(t), v = v(<), a — 
a(t), j = j(t) be the position, velocity, acceleration, 
and jerk of the link, respectively, which are functions 
of the time variable i € [0,T] for some fixed terminal 
time T < 00 . The first objective is to design a control 
input u = u(t) to drive the link such that 
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£i < P(<.) < Pi, >M < «(*i) < Vi, 

( 2 ) 

a,- < a(t.) < ai, j. < j(*,) < j,, 

i — 0, 1, . . . , n, for some pre-assigned constants 

£, Pi, Vi, a„ a,, j., Ji : i = 0,1,..., n, 

at the pre-desired time instants 

0 < < 0 < < t n <T . 

It can be easily seen from the above trajectory con- 
straints that we will have infinitely many solutions that 
satisfy the requirements. We want to find an optimal 
one from them. For this purpose, we consider the prob- 
lem of controlling the link to satisfy the above trajectory 
constraints while minimizing certain control- energy to be 
described precisely later in the next section. 

This consideration is especially important when the 
link is heavy with a large mass M and the control en- 
ergy (power source) is limited, such as in some aerospace 
engineering applications. 

A direct approach for formulating and solving such 
a nonlinear inequality-constrained optimization problem 
does not seem to be easy, unless numerically. However, as 
mentioned above, numerical solutions are undesirable if 
analytic solutions can be easily obtained, in particularly, 
for the purpose of analysis of the control system. In 
the following two sections, we will first formulate the 
problem in a suitable way and then derive an closed- 
form structure for the optimal solution. The resultant 
optimal solution is actually exact in the sense that no 
approximation will have been applied. 

3* Mathematical Formulation of the Problem 

In order to formulate the above-described nonlinear 
inequality-constrained optimization problem in a suit- 
able way, we first rewrite the motion equations in a state- 
vector setting and then verify that the resultant nonlin- 
ear system satisfies some necessary and sufficient condi- 


tions so that it can be linearized globally by a feedback, 
in the sense that an equivalent but linear closed-loop 
results. All analyses given in this section are standard 
in nonlinear systems control theory (see, again, Isidori 
(1989)) and, in fact, have been done in Marino and Spong 
(1986) (see, also, Spong and Vidyasagar (1989)) for this 
particular manipulator model. This technique was also 
used by Tam et al (1987). 

Let 

= #1, x 2 = 0i, £3 = 0 2 , #4 = 02 , 
so that equations (1) can be rewritten as 

x = f(x) + g(x)u, (3) 

where x = [xi x 3 x 3 ® 4 ] T , g(x) = [0 0 0 Z^' 1 ]" 1 ’, and 

x 2 

_ -I^MgLsinixi) - I~ 1 K(x 1 - x 3 ) 

x± 

I^ l K{xi L -x 3 ) 

For this nonlinear system, the vector fields f(x) and 
g(x) are smooth, the corresponding Lie brackets [f, g] := 
Iff - f£g are given by 

{ g, [f,g], [f,[f,g]l, [f [f, [f , g]]] } 



the vector fields 

{ g, [f,g], [f,[f,g]] } 

are constant and hence form an involutive set, and more- 
over the vector fields 

{g, [f,g], [f,[f,g]], [f[f,[f,g]]]} 

are linearly independent for all 0 < K, , I 2 < oo. Hence, 
it follows from a result of Su (1981) that the nonlinear 
system (3) is globally feedback- linearizable, in the sense 
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that an equivalent linear feedback system with an ex- 
plicit nonlinear inverse transform exists. More precisely, 
we have the following analysis: 

Let V(-) : R -* R* be the gradient vector of the 
scalar- valued argument and (•, •) a standard inner-product 
of vector-valued functions. Set y = [j/i y 2 J/3 Jm] 1 " with 

V \ = *1 

V2 = (V(j/i),f) = x 2 

V 3 = (V(y 2 ),f) = -I^'MgL sin(xi) 

< , ( 4 ) 

- ir'K( Xl - x 3 ) 

2/4 = (V(s/ 3 ),f) = —I^ 1 MgLx 2 cos(xi) 
-/f 1 A'(x 2 -i 4 ). 

Then, with the linearizing feedback control of the form 
u = f (x) + /1/2A' -1 u , (5) 


where 

F(x) = Ii l MgLsm(xi)[x% + I^ 1 MgL cos(xi) + I^ 1 K] 
+ ir'Kixi - 4- / 2 _1 )^ + I^ 1 MgLcos(xi )} , 

the nonlinear system (3) has been linearized as 

y = Ay + bv , (C) 


where 


A — 


■0 1 0 

0 0 1 

0 0 0 

.0 0 0 


0- 

0 

1 

0. 


and 


b = 


ro 

0 

0 

LlJ 


with the following physical meanings: 

yi = X\ = position of the link 
V 2 = = velocity of the link 

1/3 = V 2 = acceleration of the link 
1/4 = fa = jerk of the link . 

The original nonlinear control system and the equiva- 
lent closed-loop and linerized feedback configuration of 
the overall system are shown and compared in Figure 2 
below. 


u 


nonlinear 


system 


x 


linear n onlinear 



Figure 2. Equivalent Feedback Loops 

Here, it is important to point out that if we only 
consider the trajectory planning (constraints (2)), then 
the systems shown in Figure 2 are equivalent in the sense 
that if the trajectory of the linearized feedback system 
can be controlled to satisfy the constraints (2), then the 
same can be done for the original nonlinear system by 
inverting the nonlinear transform (4). For this reason, 
from now on we can leave the original nonlinear system 
and work on the linear system (6) together with the non- 
linear feedback (5) instead. 

Note that in the linearized feedback system, v is the 
only external and active control input, as can be seen 
from Figure 2 above. Hence, in the study of the trajec- 
tory planning for the linearized feedback system instead 
of the original nonlinear system, we may consider to min- 
imize the total control-energy of this executive input v. 
Based on this point of view, we formulate an optimal 
trajectory planning problem as follows: 

Problem: 

min / v 2 {t)dt (7a) 

v(=l 2 (0,T) J o 

subject to the linear system 

y = Ay + bv (7&) 

and the trajectory constraints 

Pj<p(U)<Pi, Vi<v(ti)<Vi, 

-> _ (7c) 

a; < a(t i) < at, j. < j(<;) < 
i = 0, 1, . . . , n, where 0 < to < <1 < • • • < t„ < T < oo. 
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Here, L 2 (0,T) denotes the standard Hilbert space 
of square-integrable real- valued functions defined on the 
time-interval [0 , T], Once we have solved the linear con- 
strained optimization problem (7a-c) for optimal v* and 
y* = [y* y* y* yJ] T , we obtain an optimal solution for 
the original problem from the inversion of (4); namely, 
from the following formulas: 


f 

2 /i* 

1 ** = 

1 

2/2 

Vi + hK - 1 [yj + Il'MgL sin(yj)] 
U 2 * + IiK-'M + ir'MgLy; cos( yi *)]J 

{ u* =F(x*) + Ji/ 2 A'-V. 


In the next section, we will show a closed-form structure 
for the optimal solution of the inequality-constrained op- 
timization problem (7a-c). 


and 

Jjh(t-r) 

0 t < T . 

Out main result can now be stated as follows: 

Theorem. The optimal solution for Problem (7a-c) is 
given by 

y*(t) = Coih_j.(t — to) + Co 2 h+(t — to) 

n — 1 

' + £ Cih+(t - U) (9) 

*=1 

- v *(t) = yl(t) , 

where Coi,Co 2 ,Ci,i = 1, . . . , n- 1, are all 4 x 4 diagonal 
constant matrices which are uniquely determined by the 
trajectory constraints (7c) from the given data set 


h+(t -t) = 


4. Closed-Form Optimal Solution 


In this section, we show the closed-form structure of 
the optimal solution for the inequality-constrained op- 
timal trajectory planning problem formulated in (7a-c) 
above. As a result, the optimal solution for the origi- 
nal nonlinear inequality-constrained optimization prob- 
lem turns out to be exact in an explicit closed-form. 

In order to state our result precisely, we need some 
new notations. In addition to the notations used before, 
set the matrix-valued exponential function 


(t_r) 


e 


0 

A r A 


I 

a-a t 


Ei(t-r) E 2 (t-r) 
Ez(t — t) E 4 (t-r) J’ 


0 < t, t < T, in which each submatrix E{(t — r),z = 
1,2, 3, 4, is a 4 x 4 block. Then, using the notation 1 := 
[1 1 1 1] T , define 


h (t — r) = E 2 (t — t) 1 


and 

( E 2 (t — r)l t > t 

h + (t~r)={ 

[ 0 t < T . 

Moreover, let 


h (< -t)= (t - t) 


Pi, Vi, Vi, °i, ii, ii, '■ * = 0,1,..., n. (10) 

Consequently, the optimal solution (u* , x*) for the origi- 
nal problem is obtained via (8) from the optimal solution 
(v*,y*) given by (9). 

We remark that the determination of the constant 
coefficient matrices of y*(<) is simple, which can be done 
easily by using any standard quadratic programming al- 
gorithm even before the manipulator control processing 
is started, so that no on-line computer is needed for 
this optimal nonlinear trajectory planning problem un- 
less adaptive control is necessary. More precisely, we 
demonstrate this procedure as follows: First, we observe 
that the minimization problem 

min f v 2 (t)dt 
veL 7 (o,T) J 0 

is equivalent to either 

f T 

min / [bd T [bi;]dt 
v€L 2 ( 0 ,T)J 0 

or 

r T 

min / [y - Ay] T [y - Ay]dt , (11) 

y£H\ (0,X) J 0 

where H i(0, T) is the standard first order Sobolev space. 
If we can solve the minimization problem (11) for y*, 
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then we can find the optimal solution v * = yj (see (6)). 
Secondly, we notice that the minimization problem (11) 
together with the inequality-constraints (10) can be re- 
formulated a s the following quadratic programming prob- 
lem: 

min C T WC (12) 

Coi ,Coa,{Ci } 

subject to 

Vd<v(ti)<Vi, 

gu^a(ti)<ai, y. <j{U)< J h 

i = 0, 1, . . . , n, where C is a constant vector consisting of 
all elements of the diagonal matrices Coi , C02, Ci, . . . , C n 
and W is a constant matrix consisting of the integra- 
tions of all elements of the functions h+ and h+. Both 
C and W have simple explicit expressions as can be eas- 
ily seen and derived from formulas (9) and (11). This 
standard quadratic programming problem can be solved 
by some existing computer routines, which will provide 
us the unique optimal solution. 

5. Conclusions 

In this paper, we have studied an optimal trajec- 
tory planning problem of a standard single-link flexible- 
joint manipulator. We first used a standard feedback- 
linearization technique to formulate the nonlinear inequa- 
lity-constrained optimization as a minimum control-energy 
problem. Then, we have derived an exact structural for- 


mula in closed-form for the optimal solution of the prob- 
lem and showed that this solution is unique. The pro- 
posed approach is applicable to both theoretical analysis 
and real-time robotics control engineering. 
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